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This  paper  deals  with  automatic  control  design  for  automotive  driving  with  a  special  focus  on  the 
longitudinal  control.  The  automotive  vehicle  is  a  complex  system  characterised  by  highly  nonlinear 
longitudinal  and  lateral  coupled  dynamics.  Consequently,  the  control  design  for  automated  driving 
should  deal  with  both  of  these  dynamic  couplings.  Indeed,  the  longitudinal  control  plays  an  important 
role  in  the  automated  guidance  to  ensure  safety  and  comfort  of  automotive  passengers.  In  this  work,  a 
nonlinear  cascade  longitudinal  control  based  on  inner  and  outer-loops  design  is  proposed.  The  lateral 
control  is  handled  following  a  model  predictive  approach  ensuring  the  automated  steering  of  the  vehicle. 
Finally,  the  nonlinear  longitudinal  control  is  integrated  with  the  lateral  control  in  a  whole  architecture  to 
perform  a  coupled  longitudinal  and  lateral  control.  The  effectiveness  of  the  automated  driving  strategy  is 
highlighted  through  simulation  results. 

©  2014  Elsevier  Ltd.  All  rights  reserved. 


1.  Introduction 

During  last  years,  the  field  of  automotive  vehicle  is  experiencing 
an  important  evolution  due  to  an  increasing  use  of  individual 
vehicles  in  everyday  life.  This  increasing  use  poses  new  challenges 
such  as  safety  and  comfort  of  car  passengers,  traffic  management, 
reduction  of  fuel  consumption  and  pollutant  emissions.  To  cope 
with  these  challenges,  several  automatic  systems  for  driver  assis¬ 
tance,  chassis  stabilisation  and  engine  control  have  been  developed 
by  automotive  manufacturers  and  academicians.  An  interesting  way 
to  investigate  the  bring  of  automatic  control  systems  can  be  the 
automated  driving  framework.  The  automated  driving  offers  an 
appropriate  framework  to  develop  and  test  new  guidance  architec¬ 
tures  that  may  equip  the  vehicles  in  the  future. 

In  this  work,  the  proposed  automated  driving  architecture  is 
depicted  in  Fig.  1  and  can  be  synthesised  into  three  main  layers. 
The  outer  layer  percepts,  using  exteroceptive  sensors  (GPS,  cam¬ 
era,  ...),  the  environment  in  which  the  vehicle  evolves  and 
provides  the  relevant  information  to  the  reference  generation 
layer.  The  reference  generation  provides  two  kinds  of  reference 
profiles,  geometric  path  and  reference  speed,  required  for  control. 
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The  reference  signals  are  computed  from  the  information  provided 
by  the  perception  layer  (see  Attia,  Daniel,  Lauffenburger,  Orjuela,  & 
Basset,  2012  and  references  therein).  The  control  layer  ensures  the 
automated  vehicle  driving  along  the  desired  path  at  desired  speed. 
This  task  is  accomplished  by  providing  the  appropriate  control 
signals,  i.e.  action  on  throttle,  brake  and  steering  wheel.  This  paper 
deals  with  the  control  design  for  automated  driving. 

The  control  law  design  for  automated  vehicle  guidance  is  a 
nontrivial  problem  due  to  the  strong  longitudinal  and  lateral 
couplings  arising  in  the  vehicle  dynamics,  for  instance: 

•  Kinematic  and  dynamic  coupling  of  the  longitudinal  and  lateral 
motions  due  to  the  yaw  motion  caused  by  the  steering  of  the 
front  wheels. 

•  The  load  transfer  phenomenon  due  to  the  longitudinal  and 
lateral  accelerations.  These  accelerations  affect  the  tyre  normal 
forces  and  so  the  longitudinal  and  lateral  tyre  forces. 

•  Tyre-road  coupling  forces  constrained  by  the  so-called  friction 
circle/ellipse.  In  fact,  the  maximal  available  tyre-road  friction  is 
distributed  between  lateral  and  longitudinal  forces. 

Hence,  the  design  of  longitudinal,  lateral  and  longitudinal/lateral 
control  strategies  becomes  particularly  arduous  due  to  the 
strongly  nonlinear  models  necessary  to  capture  these  couplings 
in  a  wide  operational  range  (Lu  &  Hedrick,  2004).  Some  authors 
attempt  to  consider  simultaneously  longitudinal  and  lateral 
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Fig.  1.  Automated  vehicle  guidance  architecture. 


couplings  to  obtain  an  only  one  controller  ensuring  coupled 
control  goals.  A  sliding  mode  technique  for  coupled  longitudinal 
and  lateral  control  is  proposed  in  Lim  (1998)  and  recently  a 
solution  based  on  flatness  control  theory  is  presented  in 
Menhour,  d'Andrea  Novel,  Boussard,  Fliess,  and  Mounier  (2011) 
and  Nehaoua  and  Nouveliere  (2012).  It  can  be  emphasised  that  the 
main  handled  couplings  are  the  dynamics  coupling  of  the  chassis 
motion.  However,  other  dynamics  should  be  considered  (e.g. 
powertain  dynamics),  therefore  increasing  the  control  law  design 
complexity.  This  complexity  can  be  partially  overcame  following  a 
decoupled  lateral  and  longitudinal  control  synthesis  under  some 
assumptions  as  proposed  in  Attia,  Orjuela,  and  Basset  (2012a). 

The  lateral  control  can  be  investigated  using  different  techni¬ 
ques.  A  fuzzy  control  approach  is  adopted  in  Maalouf,  Saad,  and 
Saliah  (2006)  to  deal  with  this  problem.  The  fuzzy  controller  is 
compared  to  a  classic  Lyapunov  controller  and  shows  effective 
performance.  A  neural  network  controller  designed  using  genetic 
algorithms  is  employed  in  Onieva  et  al.  (2010).  However,  the 
stability  proof  and  the  performance  analysis  for  artificial  intelli¬ 
gence  control  are  hard  to  be  established.  Recently,  Model  Pre¬ 
dictive  Control  (MPC)  has  been  explored  to  cope  with  this 
problem,  see  Besselmann  (2010),  Falcone,  Borrelli,  Asgari,  Tseng, 
and  Hrovat  (2007),  Keviczky,  Falcone,  Borrelli,  Asgari,  and  Hrovat 
(2006)  and  references  therein.  In  fact,  the  automatic  steering  of 
the  vehicle  is  a  complex  constrained  problem  and  MPC  is  a 
powerful  tool  which  allows  an  intuitive  handling  of  the  constraints 
on  both  state  and  control  inputs.  The  previously  quoted  papers 
have  shown  a  successful  implementation  and  have  brought  out  the 
relevance  of  the  MPC  to  cope  with  the  lateral  control. 

The  longitudinal  control  mainly  deals  with  the  development  of 
new  Active  Cruise  Control  (ACC)  which  improves  the  classic  Cruise 
Control  (CC).  The  latter  controller  is  designed  for  speed  tracking, 
particularly  in  highway  driving.  However,  some  advanced  applica¬ 
tions  such  as  autonomous  vehicle  guidance  require  high  long¬ 
itudinal  vehicle  capacities  to  track  time  varying  speeds  (Rajamani 
&  Shladover,  2001 ).  In  fact,  the  reference  speed  is  adapted  according 
to  the  driving  situations  (highway,  urban,...)  thanks  to  perception 
and  reference  generation  levels,  see  Fig.  1.  In  Nouveliere  and 


Mammar  (2007),  an  advanced  longitudinal  control  design  using 
sliding  mode  technique  is  proposed  and  experimentally  validated. 
An  ACC  based  on  a  gain- scheduling  control  technique  is  recently 
proposed  in  Shakouri,  Ordys,  Askari,  and  Laila  (2010a).  In  the  quoted 
papers,  the  authors  attempt  to  consider  the  powertrain  dynamics 
but  the  tyre-road  interaction  is  neglected.  Recently,  a  complex 
nonlinear  model  for  longitudinal  vehicle  dynamics  considering  the 
tyre-road  interaction  to  enhance  the  longitudinal  control  perfor¬ 
mance  is  proposed  in  El  Majdoub,  Giri,  Ouadi,  Dugard,  and  Chaoui 
(2012).  A  similar  approach  is  proposed  here  considering  also  the 
powertrain  dynamics. 

The  main  purpose  of  this  paper  is  to  propose  a  global  control 
strategy  for  automated  vehicle  guidance.  A  first  issue  of  an 
integrated  longitudinal  and  lateral  guidance  strategy  taking  into 
account  safety  aspects  has  been  recently  proposed  by  the  authors 
in  Attia  et  al.  (2012a).  In  that  paper,  the  lateral  control  is  based  on  a 
Nonlinear  Model  Predictive  Controller  (NMPC),  the  longitudinal 
control  is  ensured  by  a  PI  controller  and  the  powertrain  dynamics 
is  not  considered.  The  proposed  PI  longitudinal  control  is 
improved  in  Attia,  Orjuela,  and  Basset  (2012b)  using  a  direct 
Lyapunov  control  method  considering  the  powertrain  dynamics 
but  neglecting  the  tyre-road  interaction.  In  this  paper,  the  power- 
train  dynamics  as  well  as  the  tyre-road  interaction  are  handled. 
The  whole  longitudinal  controller  proposed  here  is  based  on  a 
cascade  control  architecture  for  speed  tracking  (outer-loop)  and 
torque  control  (inner-loop).  The  previously  proposed  NMPC  for 
lateral  control  is  replaced  here  by  a  linear  MPC  to  reduce  the 
computational  effort.  Finally,  the  longitudinal  and  lateral  control¬ 
lers  are  integrated  in  an  interconnected  architecture  to  perform 
automated  driving. 

The  outline  of  this  paper  is  as  follows.  The  proposed  nonlinear 
control  design  for  longitudinal  control  is  exposed  in  Section  2.  Section 
3  presents  the  linear  MPC  design  and  details  the  proposed  coupled 
longitudinal  and  lateral  control  architecture.  Simulation  results  are 
presented  in  Section  4.  Section  5  wraps  up  the  paper  by  a  discussion 
on  the  role  of  longitudinal  control  in  reducing  fuel  consumption. 


2.  Longitudinal  control  strategy 

The  goal  of  the  longitudinal  control  is  to  ensure  the  tracking  of 
time-varying  reference  speed.  The  whole  longitudinal  dynamics  of 
the  vehicle  is  characterised  by  a  set  of  nested  complex  systems.  An 
external  system  characterises  the  relationship  between  the  vehicle 
speed  and  the  applied  torque  on  the  wheels.  Its  dynamics  is 
governed  by  the  longitudinal  motion  resulting  from  tyre-road 
contact  forces.  An  internal  system  describes  the  interaction 
between  the  throttle  and  brake  actions  and  the  produced  torque. 
This  last  implies  complex  elements  such  as  engine,  gearbox  and 
driveline. 

The  longitudinal  control  problem  is  tackled  through  a  cascade 
control  architecture  depicted  in  Fig.  2.  The  use  of  a  cascade  control 
has  been  motivated  by  the  structure  of  the  longitudinal  dynamics. 
In  this  control  architecture  an  outer-loop  ensures  the  reference 
speed  tracking  and  calculates  the  torque  to  be  applied  on  the 
wheels.  An  inner-loop  provides  the  throttle  opening  and  the  brake 
pressure  to  generate  the  required  control  torque.  In  the  forth¬ 
coming  subsections  both  outer  and  inner-loops  are  designed  and 
the  whole  control  architecture  is  analysed. 

2.1.  Outer-loop  design  for  reference  speed  tracking 

Consider  a  one-wheel  vehicle  model,  the  longitudinal  motion 
of  the  vehicle  is  governed  by  Nouveliere  and  Mammar  (2007): 

mv  =  F[-  Cav2  -  Crmg  cos  ( 6 )  -  mg  sin  (i 9 ) 


(1) 
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Fig.  2.  Longitudinal  control  architecture. 


where  v  is  the  vehicle  speed,  m  the  vehicle  mass,  F/  the  traction 
force,  Ca  the  aerodynamic  coefficient,  Cr  the  rolling  resistance 
moment,  Othe  road  slope  and  g  the  gravitational  acceleration. 
The  traction  force  F/  results  from  the  tyre-road  contact  and  acts  on 
the  wheel  dynamics  as  following: 


converges  towards  zero.  For  that  purpose,  the  longitudinal  slip  (5) 
is  expressed  differently  in  acceleration  and  deceleration  phases. 
In  acceleration  phase  the  longitudinal  slip  is  expressed  by 


2  =  1- 


Rco 


(9) 


/  w  go  —  — RF  i  tTw 


(2)  and  its  time  derivative  by 


where  Iw  is  the  wheel  inertia,  go  the  wheel  rotational  speed,  R  the 
wheel  radius  and  Tw  the  applied  torque  (traction  or  braking)  on 
the  wheel.  The  traction  force  F/  results  from  the  tyre-road  contact 
and  is  given  by 

Fl^ftyre&VJ,)  (3) 

where  ftyre  is  a  nonlinear  function,  2  the  longitudinal  slip,  //  the 
friction  coefficient  which  depends  on  road  conditions  and  Fz  the 
wheel  vertical  load.  Several  models  of  different  complexity  are 
proposed  in  the  literature  to  characterise  the  nonlinear  function 
ftyre  according  to  the  modelling  purpose  (see  Kiencke  &  Nielsen, 
2000  for  an  overview  on  tyre  modelling).  In  normal  driving 
situations,  i.e.  moderate  acceleration/deceleration  (<3ms-2), 
assuming  a  constant  friction  coefficient  ji  and  a  constant  vertical 
load  Fz,  the  friction  force  F/  can  be  expressed  by  the  following 
linear  tyre  model: 

Fi  =  Q  A  (4) 

where  Q  is  the  longitudinal  stiffness  coefficient  and  A  the  long¬ 
itudinal  slip  ratio  given  by 

l=  R<»-v  (5) 

ma  x(Rco,  v) 


Let  the  longitudinal  reference  speed  be  a  continuously  differenti¬ 
able  signal  vref  and  the  tracking  speed  error  defined  by 

ev  =  v  -  vref  (6) 


i-  - (*<; -tf + wy  ^ 

Jwv  mv  J  A  Iwv  mv 

where  Fr  gathers  the  different  resistance  forces: 

Fr(v)  =  ^v2  +  Crg  cos  (<9)+g  sin  (6) 

In  deceleration  phase  the  longitudinal  slip  is  given  by 

A  =  ^-l 
v 

and  its  time-derivative: 


(10) 


(11) 


(12) 


R2  1+2 


1  +Ar 


A  —  —  (  t - 1 - ]  C^2 + - — Tw  -| - F r(v) 

\/wv  mv  /  x  Iwv  mv 


(13) 


It  can  be  emphasised  that  the  tyre  remains  in  its  linear  operating 
range  for  a  longitudinal  slip  ratio  into  the  interval  A  e  [-0.07,  0.1] 
as  mentioned  in  El  Majdoub  et  al.  (2012).  Beyond  these  limits,  the 
tires  are  saturated  and  the  vehicle  enters  in  pure  slip  motion. 
Taking  into  account  these  considerations,  the  following  approx- 


imation  can  be  considered: 

1  -A2  =  (1  -A)(l  +2)  1 

(14) 

with: 

f  1-2  if 2>0 
'  '  ~  [  1  +2  otherwise 

(15) 

then,  the  tracking  error  dynamics  is  given  by 

^v  =  m/l~mv2~Crg  C0S(^S  sin(0)-vref  (7a) 

do  -  -5+1++  (7b) 

1 W  1 W 

by  considering  (1)  and  (2)  and  the  longitudinal  slip  (5). 

Remark  that  the  use  of  a  direct  Lyapunov  approach  to  stabilise 
the  model  (7)  is  not  straightforward  as  shown  in  El  Majdoub  et  al. 
(2012).  In  fact,  the  speed  tracking  error  (7a)  and  the  wheel 
rotational  speed  (7b)  are  related  through  the  longitudinal  slip 
(5).  Consequently,  the  stabilisation  of  (7a)  is  achieved  here 
following  a  backstepping  approach  using  a  virtual  control  input 
A*.  Then,  the  control  input  Tw  is  calculated  such  as  the  longitudinal 
slip  tracking  error: 

eA=A-A*  (8) 


Then,  considering  (14)  and  (15),  the  longitudinal  slip  dynamics  in 
both  acceleration  and  deceleration  modes  can  be  expressed,  in  a 
unified  form,  as 


2  =  (1  —  \A\)  - 


l-A)  1 
Iwv  ^  mv 


_  .  ,  R(l-2)_  1  „  ,  , 

Q2h — z - Tw  h - Fr(v) 

x  Iwv  mv 


and  the  longitudinal  motion  dynamics  is  finally  rewritten 
(7a)  and  (16)  as  follows: 


ev  =  —A  — 

m 


m 


Vref 


(16) 

using 


(17a) 


2  =  (|2|-1) 


+2( l-A)  |  \  \ 

l  /wv  +  mvj 


QA- 


m-X)T 

IwV 


W 


(17b) 


The  control  design  is  achieved  in  two  steps  based  on  the  direct 
Lyapunov  approach.  In  the  first  step,  the  virtual  control  A *  is  obtained 
to  stabilise  (17a)  with  the  help  of  the  following  Lyapunov-candidate 
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function: 


and  the  powertrain  dynamics  can  be  modelled  by 


V,=\e2v  (18) 

The  exponential  stability  of  the  tracking  error  can  be  investigated 
satisfying  the  condition: 

V\  =  —2kvV\  (19) 


where  kv  >  0  is  a  tuning  parameter  for  convergence  rate.  The  time 
derivative  of  Eq.  (18)  is  given  by 

V1=evev  (20) 


which  becomes 

Vi  =  ev(-A~- 
{  m 


m 


(21) 


and  by  using  the  stability  condition  (19),  the  following  virtual  control 
law  is  suggested: 

r  =  g(-fcvev+^+vre/)  (22) 

In  the  second  step,  the  control  torque  Tw  is  computed  to 
stabilise  the  longitudinal  speed  tracking  error  (8)  using  a  similar 
approach.  The  stabilising  control  law  is  designed  considering  the 
Lyapunov-candidate  function: 


IeNe  —  Te(ut,  Ne)  — 


(28a) 


Tw  =  RfRtrCtr 


(28b) 


where  Ie  and  Ne  are  the  engine  moment  of  inertia  and  speed,  I<tc 
the  K-factor,  Rf  the  final  drive  ratio,  Rtr  the  gearbox  ratio.  The 
engine  torque  Te  depends  on  the  engine  speed  Ne  and  the  throttle 
opening  ut  following  the  relationship  (Guzzella  &  Sciarretta, 
2005): 

Te(ut,  Ne)  =  Tei+(a0  +  a1Ne  +  a2N2)Ut  (29) 

where  Tei  is  the  engine  torque  when  the  throttle  is  closed.  A 
characteristic  of  a  gasoline  engine  is  given  in  Fig.  3. 

In  this  paper,  a  gain  scheduling  PI  control  strategy  is  adopted  to 
cope  with  the  torque  control.  This  approach  allows  to  overcome 
the  difficulties  introduced  by  the  discrete  changes  of  the  gear  ratio. 
A  set  of  PI  controllers  are  synthesised  considering  the  linearisation 
of  the  model  (28)  at  different  steady-state  points  {Neo,uto=  0} 
corresponding  to  the  different  gear  ratios: 

IeANe=  —  2—f-ANe-\-(ao-\-a-[Neo-\-a2N^Q)Ut  (30a) 

'  tc 


V2  =  \e\  (23) 

and  the  exponential  stability  condition: 

V2=-kAV2  (24) 

where  kx  >  0.  The  following  stabilising  control  law  can  be  derived: 
fwV 


T*  = 
1  — 


J?(i-Ui)(i-/l) 

,  1  — 12|  1-|/1|/r2(1-/1)  1, 

X  X  777V  V  \  Iw  777  ' 


(25) 


where 

;*  777 

A  =  — 


_kv(Se'i_kvev) +^^?(S€i_kvev+i:'re/) +i>re/ 


(26) 


Tw  —  2RfRtrC[r^-ANe  (30b) 

'tc 

where  A Ne  =  Ne-Ne0.  The  scheduling  of  this  set  of  controllers  is 
governed  by  the  actual  gearbox  ratio.  The  stability  analysis  for  this 
gain-scheduling  strategy  is  not  the  main  topic  of  the  present  work, 
see  Rugh  and  Shamma  (2000)  for  details  on  gain-scheduling 
design  techniques. 

2.3.  Stability  of  the  cascade  control  loop 

In  the  previous  sections  the  inner  and  outer  controllers  are 
separately  synthesised  .  Here,  the  behaviour  of  the  cascade  control 
is  analysed  assuming  that  the  inner-loop  is  exponentially  stable. 
Consequently,  the  following  condition  holds: 

Cj  =  —kjej  (31) 


Finally,  by  considering  the  control  laws  (22)  and  (25),  the  closed 
loop  dynamics  is  given  by 


"ev‘ 

~ -kv 

Q  1 

m 

ev 

0 

-h_ 

Notice  that,  the  closed  loop  dynamics  (27)  is  stabilised  for  any 
strictly  positive  tuning  parameters  kv  and  kx.  The  convergence  rate 
can  be  tuned  using  these  parameters. 

2.2.  Inner-loop  design  for  torque  controller 

The  inner-loop  ensures  the  tracking  of  the  torque  reference 
provided  by  the  outer-loop.  The  engine  torque  controller  acts  on 
the  throttle  input  to  track  the  required  torque.  The  applied  wheel 
torque  is  related  to  the  throttle  input  through  a  complex  nonlinear 
relationship  due  to  the  engine  and  the  powertrain  dynamics.  The 
available  engine  torque  depends  on  the  throttle  opening  as  well  as 
the  engine  speed,  this  relationship  is  often  given  by  lookup  tables. 
The  gearbox  is  also  an  important  element  in  the  powertrain 
dynamics  and  affects  the  engine  behaviour  through  gear  shifts. 
The  gearbox  introduces  the  discrete  parameter,  the  gearbox  ratio, 
which  should  be  handled  by  the  engine  torque  controller. 
As  mentioned  in  Shakouri,  Ordys,  and  Askari  (2012),  the  engine 


where  the  torque  tracking  error  is  defined  by 

0t  =  Tw  —  T'w  (32) 


Maximum  engine  torque  vs.  engine  speed 
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with  Tw  is  the  actual  torque  and  T*  the  desired  torque.  From  (32), 
the  impact  of  inner-loop  dynamics  on  the  cascade  control  can  be 
considered  as  follows: 


Tw  =  T*+er 

At  this  point,  (33)  and  (17b)  can  be  used  to  obtain: 


?a= -he  a  + 


hvV 


eT 


(33) 


(34) 


Finally,  using  (27)  and  (34)  the  whole  cascade  loop  dynamics  is 
expressed  by 

G 


~ev~ 

At  _ 

— 

-/<v 

o  -h 

o  o 


o 

R(  1-|A|)(1-A) 
Jwv 

—  kj 


"ev" 

_eT_ 

(35) 


It  is  important  to  note  that  (35)  is  a  Linear  Parameter  Varying 
(LPV)  system.  Therefore,  the  stability  cannot  be  investigated  based 
on  the  eigenvalues  of  the  dynamic  matrix  due  to  the  time-varying 
term: 


(36) 

However,  the  stability  can  be  established  considering  the  bounded 
variation  of  the  parameter  pe{p,  p].  Under  this  assumption,  the 
time-varying  term  p  can  be  rewritten  as  follows: 

P  =  P\P_+PiP  (37) 

where 


P\  =  —  P  and  p2  =  —  ~  (38) 

P-P  P-P 

verifying  the  following  convex  properties: 

2 

2  p{  =  1  and  0  <  pt  <  1  i  =  l,2  (39) 

i=  1 

Thanks  to  the  proposed  transformation  (37),  the  Eq.  (35)  is 
rewritten  as  follows: 

e  =  2  pAe  (40) 

i  =  1 

where 


e  = 

~ev~ 

eA 

>  A  = 

1° 
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(41) 

Finally,  the  system  (40)  is  exponentially  stabilised  if  the  following 
condition  is  satisfied  (Boyd,  El  Ghaoui,  Feron,  &  Balakrishnan, 
1994): 

AfP+PAi  +  2aP<0  for  i  =  l,2  (42) 

where  a  is  strictly  positive  scalar  and  P  a  symmetric  definite 
positive  matrix  of  appropriate  dimension  to  be  found  using  Linear 
Matrix  Inequality  (LMI)  solvers  (see  Section  4.2). 

As  far  as  here,  it  is  assumed  that  the  inner-loop  is  exponentially 
stable.  However,  the  exponential  stability  is  usually  hard  to  obtain 
for  the  gain  scheduling  strategy.  It  can  be  interesting  to  analyse  the 
stability  when  the  tracking  error  of  the  inner-loop  does  not  vanish 
but  remains  in  a  certain  neighbourhood  of  the  origin.  For  that 
purpose,  the  cascade  dynamics  Eq.  (35)  is  modified  as  follows: 

e  =  2  pAe+Bd  (43) 

i  =  1 

where  BT  =  [0  0  1]  and  d  =  d(t )  is  an  energy  bounded  disturbance. 
In  this  case,  an  attenuation  level  of  the  disturbance  effect  on  the 
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Fig.  4.  Gear  shift  strategy. 


tracking  error  vector  e  can  be  expressed  as  follows: 
llelll 


<y,y>  0 


(44) 


where  y  is  the  attenuation  level  and  \\z\\2  the  l2  norm  of  z  defined 
by 


Jr  OG 

zT(t)z(t)  dt  (45) 

0 

Both  exponential  stability  and  disturbance  attenuation  are  met 
if  the  following  condition  holds  (Boyd  et  al.,  1994): 

V<-2  ccV-eTe+ydTd  (46) 

where  V  is  a  Lyapunov-candidate  function,  for  instance: 


V  =  eIPe  P  =  P1>0 


(47) 


For  a  given  a,  A/  and  B,  the  LMI  formulation  of  the  condition  (44)  is 
then  expressed  as  Boyd  et  al.  (1994): 


mmy 


A\P+ PAi  +  2aP + I  PB 


BlP 


-Yl 


<0  for  i  =  l,2 


(48) 


where  /  is  the  identity  matrix  of  appropriate  dimension.  This  LMI  is 
not  used  to  design  the  controller  gains  kv,  kx  and  kT  but  only  to 
investigate,  a  posteriori,  closed-loop  performance  (i.e.  decay  rate 
and  disturbance  attenuation  level).  In  fact,  numerical  solution  of 
the  LMI  cannot  be  found  for  a  high  decay  rate  a  and  y  <  1 ,  a  trade¬ 
off  between  decay  rate  and  attenuation  level  should  be  found. 


2.4.  Automatic  gear  shift  management 

As  mentioned  above,  the  available  control  inputs  are  the 
throttle,  the  brake  and  the  gearbox.  A  management  policy  should 
be  defined  to  handle  the  working  exclusivity  between  throttle  and 
brake  and  a  gear  shift  policy  also  has  to  be  determined.  The 
switching  between  throttle  and  brake  is  defined  based  on  the 
throttle  opening  value  given  by  the  nonlinear  torque  controller 
and  the  speed  tracking  error.  The  brake  is  activated  if  the  throttle 
is  inactive  and  the  vehicle  speed  is  greater  than  the  reference 
speed.  The  automatic  gear  shift  management,  i.e.  determining  the 
adequate  gearbox  ratio  at  each  instant  time,  is  a  complex  optimi¬ 
sation  problem  (Guzzella  &  Sciarretta,  2005)  and  will  not  be 
addressed  in  this  work.  However,  several  studies  show  that  the 
optimal  engine  operating  point  for  small  road  gradients  is  reached 
around  2750  rpm  (Luu,  Nouveliere,  &  Mammar,  2010).  From  this 
observation,  the  solution  adopted  here  results  of  an  automatic 
gearbox-like  system  modelled  by  the  statechart  shown  in  Fig.  4. 


3.  Combined  longitudinal  and  lateral  control 

In  this  section,  the  lateral  control  design  is  presented  and  the 
whole  guidance  strategy  is  detailed. 
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3A.  Lateral  control  strategy 


The  lateral  controller  ensures  the  steering  of  the  vehicle  to 
follow  a  given  geometric  trajectory.  For  control  design  a  linearised 
lateral  model  of  the  vehicle  is  shortly  introduced.  The  lateral 
behaviour  of  the  vehicle  can  be  described  in  the  linear  operating 
range  by  the  well-known  bicycle  model.  The  motion  equations  of 
the  linear  bicycle  model  depicted  in  Fig.  5  are  given  by  Kiencke 
and  Nielsen  (2000): 
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(49) 


where  href  is  the  reference  output  and  Nc  the  control  time-horizon 
which  corresponds  to  the  optimisation  problem  dimension  to  be 
solved.  Matrices  Q  and  R  respectively  represent  the  weights 
regarding  the  tracking  errors  and  the  control  input  energy;  the 
choice  of  these  weight  matrices  is  a  classical  issue  in  optimal  and 
predictive  control  (Mayne,  Rawlings,  Rao,  &  Scokaert,  2000). 

The  LMPC  problem  to  cope  with  the  lateral  control  is  formu¬ 
lated  as  follows  Attia  et  al.  (2012a): 


arg  minjicik),  Au) 

(52a) 

Au 

.  £(k-Fn-F  1  |/c)  =  7\(f^(fc+ n|/c)+B(/U(/c+ n\k) 

(52b) 

h(k+n\k)  =  Cdg(k+n\k) 

(52c) 

umin<u(k+n\k)<um3X 

(52d) 

where  vy  is  the  lateral  speed,  r  the  yaw  rate,  Y  the  lateral  vehicle 
position,  the  heading  angle,  vx  the  longitudinal  vehicle  speed, 
<5f  the  steering  angle,  lf  and  lr  the  front  and  rear  CoG-distance, 
m  the  vehicle  mass  and  Iz  the  moment  of  inertia  around  the  vertical. 
A  linear  tyre  model  (similar  to  (4))  is  employed  for  lateral  tyre 
forces  modelling  considering  the  front  and  rear  cornering  stiffness 
coefficients  Cf  and  Cr. 

Notice  that  the  linearised  model  of  the  vehicle  (49)  depends  on 
the  longitudinal  speed  vx.  The  authors  have  proposed  a  Nonlinear 
Model  Predictive  Control  (NMPC)  to  cope  with  the  lateral  control 
problem  in  a  previous  work  (Attia  et  al.,  2012a).  The  proposed 
approach  is  based  on  a  nonlinear  model  capturing  both  of  long¬ 
itudinal  and  lateral  dynamics  and  shows  an  effective  trajectory 
tracking.  However,  the  NMPC  requires  to  solve  a  nonlinear 
optimisation  problem  on-line  and  does  not  meet  real-time  con¬ 
straints.  In  order  to  overcome  this  limitation,  a  Linear  MPC  is 
adopted  here  under  the  assumption  of  slowly  varying  longitudinal 
speeds. 

The  MPC  allows  reference  tracking  considering  constraints  on 
both  control  inputs  and  state  variables  (Re,  Allgower,  Glielmo, 
Guardiola,  &  Kolmanovsky,  2010).  The  controlled  inputs  are 
calculated  at  each  sampling  time  thanks  to  an  on-line  optimisation 
minimising  the  tracking  errors  between  the  predicted  and  the 
reference  outputs  on  a  prediction  time-horizon  Np.  The  predicted 
outputs  are  obtained  from  a  prediction  model  obtained  from  the 
discretisation  of  the  continuous-time  bicycle  model  (49).  Euler's 
approximation  is  used  for  that  purpose  and  the  discrete-time 
model  is  given  by 

£(/<+ 1)  =  Adi;(k) + Bdu(k) 

h(k)  =  Cdm  (50) 

where  £  =  [vy  r  Y  Y?  and  h  =  [Y  *F]T. 

The  cost  function  usually  employed  in  the  MPC  optimisation 
problem  is  given  by  Re  et  al.  (2010): 

Np  Nc- 1 

J=  t  II h(/< + n|/<) - href(1< + n) || q  +  £  \\u(k+n\k)\\R  (51) 

n  =  1  n  =  0 


A umin  <  Au(k+n\k)  <  Aumax  (52e) 

u(k +n\k)  =  u(k+n-l\  k )  +  Au(k + n  |  /<)  (52f) 

Au(k-\-n\k)  =  0  for  n  =  Nc,  ...,NP 

where  Ad,  Bd  and  Cd  are  already  defined  by  (50).  The  notation 
£(/<+n|/0  means  that  the  predicted  value  of  £  at  instant  k+n  such 
that  £(/<|/<)  =  £(/<)  i.e.  at  each  sampling  time  the  initial  state  for 
prediction  is  updated  using  the  available  measurements.  Using  the 
discrete-time  model  (50),  the  future  states  of  the  system  are 
calculated  following  the  expression: 

H  =  F£(k)+®AU  (53) 

where  H  =  [h(/c+l|/<),  ...,fr(/<+Np|/<)]T,  AU  =  [u(k\k)9  ...,u(k+Nc\k)]T 
and  the  matrices  F  e  u2Npx4  and  0  e  u2NpxNc  given  by 
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Consider  (53)  and  define  Href  as  the  reference  outputs  for  the 
prediction  horizon  then  the  optimisation  criterion  (51)  is  written 
as  follows: 

J  =  (Href-H)TQ(Hre/-H)+AUTRAU  (55) 

where  Qe  r2Npx2Np  and  J?elRNcxNc  are  the  weights  matrices. 
Finally,  the  optimisation  criterion  (55)  is  written  in  a  standard 
Linearly  Constrained  Quadratic  Programming  (LCQP)  problem: 

J  =  (Href  -  F£(t))TQ(Href  -  Ffrt))  -2AUT0\Href  -  F&t))  +  AUT(<PT0R)AU 

(56) 

and  the  LCQP  is  then  expressed  as 

arg  min/(AU)  =  AUT(&T<PR)AU-2AUT<PT(Href-FZ;(t))  (57a) 

Au 

S.t.  AeqAU  <  beq  (57b) 


where  Aeq  and  beq  gather  linear  constraints  on  AU. 

3.2.  Longitudinal  and  lateral  couplings 

The  developed  longitudinal  and  lateral  controllers  are  inte¬ 
grated  in  a  whole  guidance  strategy  to  ensure  a  coupled  control. 
In  fact,  the  lateral  control  acts  as  a  disturbance  on  the  longitudinal 
dynamics.  However,  the  effect  of  the  steering  on  the  longitudinal 
speed  tracking  can  be  neglected  in  normal  driving  situations.  On 
the  other  hand,  the  longitudinal  speed  tracking  largely  affects  the 
lateral  dynamics.  Thus,  the  variations  of  the  longitudinal  speed 
should  be  considered  in  the  coupled  control  approach  as  shown  in 
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Vehicle  Trajectory 


Vehicle  Speed 


Fig.  6.  Coupled  longitudinal  and  lateral  control. 


Fig.  6.  In  fact,  the  longitudinal  speed  vx  acts  on  the  lateral  control 
such  as  an  external  disturbance.  This  interaction  is  given  by  the 
time-varying  parameter  vx  in  the  bicycle  model  (49).  Several  MPC 
algorithms  for  Linear  Parameter  Varying  (LPV)  systems  are  pro¬ 
posed  in  the  literature.  In  Besselmann  and  Morari  (2009)  a 
synthesis  algorithm  based  on  explicit  solution  of  the  LPV-MPC 
problem  is  proposed.  Another  approach  based  on  successive 
linearisations  is  proposed  in  Falcone  et  al.  (2007).  Here,  it  is 
assumed  that  the  longitudinal  speed  is  slowly  varying  and  could 
be  considered  constant  over  the  prediction  horizon  (here 
Np  x  Ts  =  70  ms).  Then,  the  LPV-MPC  problem  is  reduced  to  the 
solution  of  a  standard  LMPC  problem  at  each  sampling  time.  This 
formulation  allows  to  consider  the  effect  of  the  varying  long¬ 
itudinal  speed  on  the  lateral  guidance.  Thus,  the  interconnected 
control  architecture  presented  in  Fig.  6  allows  to  handle  the 
problem  of  a  coupled  longitudinal/lateral  control. 


For  a  maximum  decay  rate  a =3.95,  a  solution  satisfying  the  a 
posteriori  robust  exponential  stability  condition  (48)  is  given: 


0.0141 

0.0141 

-0.0001 


0.0141 

0.1024 

0.0001 


-o.ooor 

0.0001 

0.9528 


(59) 


with  the  attenuation  level  y= 0.9074.  Consequently,  the  impact  of 
the  virtual  disturbance  d  on  the  tracking  error  vector  e  is 
attenuated.  Here,  the  value  considered  for  a  is  maximum  value 
satisfying  (48).  Note  that  the  attenuation  level  can  be  decreased 
considering  a  lower  decay  rate  a. 

The  sampling  time  Ts  =  \0ms  is  a  common  choice  in  the 
vehicle  control  framework  and  depends  on  the  implementation 
technology.  The  choice  of  the  MPC  parameters  Np,  Nc,  Q.  and  R 
has  been  fixed  through  a  trial  and  error  approach.  To  the  best 
knowledge  of  the  authors,  there  is  not  a  systematic  method  to 
choose  a  priori  the  MPC  parameters  ensuring  stability  and  desired 
performance,  particularly  in  trajectory  tracking  problems.  The 
stability  analysis  of  the  MPC  scheme  goes  beyond  the  scope  of 


Fig.  7.  Vehicle  longitudinal  simulation  model. 


4.  Tests  and  simulations 

The  effectiveness  of  the  proposed  control  design  is  shown 
through  realistic  simulations.  Firstly,  the  longitudinal  control 
strategy  is  tested  for  the  tracking  of  time-varying  reference  speed. 
After  then,  the  automated  driving  through  defined  trajectory  at 
variable  speed  is  performed  using  the  proposed  integrated  long¬ 
itudinal/lateral  guidance  architecture. 

4A.  Simulation  conditions 

The  validation  of  the  longitudinal  control  is  achieved  using  the 
full  car  drivetrain  benchmark  available  in  Matlab/Simulink 
(Shakouri,  Ordys,  Askari,  &  Laila,  2010b).  In  this  way,  the  synthesis 
model  previously  presented  is  not  the  same  as  the  validation 
model.  Indeed,  the  validation  model  considers  an  engine  map  as 
well  as  a  mechanical  modelling  of  the  driveline  and  the  gearbox  as 
it  can  be  seen  in  Fig.  7. 

For  the  whole  guidance  strategy  validation,  the  2D  nonlinear 
chassis  model  with  a  nonlinear  tyre  model  presented  in  Attia  et  al. 
(2012a)  is  employed.  Table  1  summarises  the  main  parameters  of 
the  longitudinal  and  lateral  models. 

4.2.  Parameters  of  the  controllers  and  stability  analysis 


Table  1 

Parameters  of  the  longitudinal  and  lateral  models. 


Parameter 

Description 

Value 

Longitudinal  model  parameters 

Cx 

Longitudinal  tyre  stiffness 
coefficient 

200  000  N/rad 

Ca 

Aerodynamic  coefficient 

0.13  kg/m 

Cr 

Rolling  resistance  coefficient 

150 

g 

Gravity 

9.81  ms-2 

le 

Engine  inertia 

1  kg  m2 

Iw 

Wheel  inertia 

0.9  kg  m2 

I<tc 

K-factor 

30 

* 

Final  drive  ratio 

3.28 

Rtr 

Gearbox  ratio 

[1:2.34,  2:1.45,  3:1.00,  4:0.68] 

Linear  bicycle  model  parameters 

m 

Vehicle  mass 

1700  kg 

h 

Moment  of  inertia 

3048  kg  m2 

If 

Front  CoG-distance 

1.04  m 

lr 

Rear  CoG-distance 

1.6  m 

Cf 

Front  cornering  stiffness  coefficient 

105  700  N/rad 

Cr 

Rear  cornering  stiffness  coefficient 

79  000  N/rad 

Table  2 

Controller  parameters. 

Parameter 

Description 

Value 

The  parameters  of  the  longitudinal  and  lateral  controllers  are 
given  in  Table  2.  A  solution  satisfying  the  a  posteriori  exponential 
stability  condition  given  by  the  LMI  (42)  is  computed  using  the 
SeDuMi  solver  (Sturm,  1999)  and  the  Yalmip  interface  (Lofberg, 
2004).  For  a  given  decay  rate  a  =  4.7,  the  matrix  P  obtained  is 


P  = 


0.0141  0.0181  -0.0000" 

0.0181  0.0886  0.0004 

-0.0000  0.0004  1.3650 


(58) 


Longitudinal  controller  parameters 
kv  Decay  rate 

kx  Decay  rate 

kT  Decay  rate 


Lateral  controller  parameters 

Q  Error  tracking  weighting  matrix 

R  Control  input  weighting  matrix 

Np  Prediction  horizon 

Nc  Control  horizon 

Ts  Sampling  time 


70 

35 

5 

[J?] 

0.05 

7 

4 

10  ms 
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this  paper  (details  on  stability  analysis  for  MPC  can  be  found  in 
Mayne  et  al,  2000). 

4.3.  Longitudinal  control  test 

The  proposed  longitudinal  control  is  tested  in  tracking  different 
reference  speeds  in  acceleration  and  deceleration  phases.  The 
speed  tracking  results  are  shown  in  Fig.  8(a).  The  tracking  of  the 
reference  speed  in  acceleration  and  deceleration  phases  is  realised 
through  throttle  and  brake.  Fig.  8(b)  shows  the  evolution  of  the 
action  on  the  throttle  and  brake.  The  speed  tracking  is  more 
effective  in  deceleration  phases  owing  to  the  high  braking  cap¬ 
abilities.  Fig.  8(c)  shows  the  evolution  of  the  engine  speed,  it  can 
be  noted  that  the  engine  speed  remains  in  an  acceptable  operating 
range  [2000  rpm,3000  rpm]  thanks  to  the  adopted  gear  shift 
policy,  see  Section  2.4.  Note  that  the  vehicle  speed  is  regulated 
at  different  values  to  highlight  the  gear  shifts  at  time  instants 
{21.3  s,  31.8  s,  70.4  s},  as  illustrated  in  Fig.  8(d). 

Fig.  9  presents  comparative  simulations  between  the  control 
strategy  proposed  here  and  the  control  approach  given  in  Attia 
et  al.  (2012b)  respectively  named  controller  1  and  controller  2.  The 
reference  speed  profile  and  the  vehicle  response  using  both 
controllers  are  shown  in  Fig.  9(a).  The  throttle  opening  and  brake 
activation  are  given  in  Fig.  9(c)  and  (d).  Controller  1  shows  more 
effective  speed-tracking  as  shown  in  Fig.  9(b).  Note  that,  between 
50  s  and  60  s  a  resistive  gravitational  force  acting  as  an  external 
disturbance  is  applied.  The  magnitude  of  this  disturbance  repre¬ 
sents  a  10%  positive  slope.  Fig.  9(b)  shows  also  a  better  perturba¬ 
tion  rejection  using  the  proposed  control  strategy. 

4.4.  Coupled  longitudinal  and  lateral  test 

For  the  whole  guidance  architecture  tests  the  reference  trajec¬ 
tory  to  be  tracked  by  the  vehicle  is  obtained  from  reference 
generation  level  using  real-world  GPS/Cartography  data,  further 


details  on  the  reference  generation  aspects  are  available  in  Attia 
et  al.  (2012).  The  fully  automated  vehicle  guidance  is  performed 
through  an  integrated  longitudinal  and  lateral  control  strategy. 
The  effectiveness  of  the  whole  control  strategy  is  shown  by 
performing  path  and  speed  tracking  on  a  given  trajectory  calcu¬ 
lated  from  real-world  data.  The  road  geometry  coordinates  are 
calculated  based  on  numerical  map  data  and  the  reference  speed 
profile  is  generated  considering  safety  and  comfort  criteria  as 
discussed  in  Attia  et  al.  (2012a).  Fig.  10(b)  shows  the  reference  and 
the  vehicle  trajectories.  The  lateral  position  as  well  as  the  heading 
angle  errors  are  shown  in  Fig.  10(c).  It  can  be  noticed  that  the 
tracking  errors  are  very  acceptable.  The  speed  tracking  results  are 
shown  in  Fig.  10(d).  Remark  that  the  test  trajectory  includes 
different  driving  situations,  first  on  a  highway  at  110  km/h,  then 
in  the  highway  exit  where  an  important  lateral  solicitation  at 
reduced  speed  (20  km/h  to  50  km/h)  is  performed  and  finally  an 
acceleration  phase  to  reach  the  speed  of  90  km/h  on  a  rural  road. 
Thanks  to  the  proposed  integrated  longitudinal/lateral  control 
strategy,  the  fully  automated  guidance  of  the  vehicle  is  evaluated 
along  a  typical  road. 


5.  Conclusions  and  perspectives 

5.1.  Energy  consumption  reduction  discussion 

The  objective  of  the  proposed  control  strategy,  in  both  long¬ 
itudinal  or  longitudinal/lateral  dimensions,  is  to  provide  global  and 
effective  vehicle  guidance  strategies  that  could  be  extended  to  take 
fuel  consumption  aspects  into  account.  The  energy  management 
can  be  introduced  at  different  layers  in  the  guidance  architecture 
proposed  here.  The  first  way  is  to  introduce  energy  consumption 
criteria  at  the  reference  generation  layer.  In  fact,  the  generation  of 
smooth  reference  speed  profiles  helps  to  guarantee  eco-friendly 
driving  and  contributes  to  reduce  energy  consumption.  In  this 
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Fig.  8.  Longitudinal  control  simulation  results,  (a)  Reference  and  vehicle  speeds,  (b)  throttle  and  brake  switching,  (c)  engine  speed  and  (d)  gear  shifts. 
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Fig.  9.  Comparative  simulation  results,  (a)  Reference  and  vehicle  speeds,  (b)  speed-tracking  errors,  (c)  throttle  activation  and  (d)  brake  activation. 
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Fig.  10.  Combined  longitudinal  and  lateral  control  test,  (a)  Highway  exit  map,  (b)  reference  and  vehicle  trajectories,  (c)  lateral  position  and  heading  errors  and  (d)  reference 
speed  tracking. 


paper,  the  reference  speed  generation  is  done  without  considering 
road  slope  variations.  The  authors  aim  to  generalise  the  approach 
proposed  in  Daniel,  Birouche,  Lauffenburger,  and  Basset  (2011)  by 


considering  3D  cartography  and  trajectory  generation.  The  pro¬ 
posed  longitudinal  control  allows  to  handle  this  additional  infor¬ 
mation  since  the  rolling  resistance  forces  are  considered  in 
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controller  design.  The  second  way  is  to  improve  the  torque  control 
by  optimising  the  gear  sequence.  The  assumption  made  in  this 
work  allows  to  keep  the  engine  speed  in  an  acceptable  range  not 
far  from  the  optimal  operating  point.  These  aspects  are  investi¬ 
gated  in  the  literature  through  optimisation  approach.  In  Luu  et  al. 
(2010)  the  problem  of  minimising  fuel  consumption  on  a  known 
road  part  using  a  dynamic  programming  approach  is  proposed.  A 
look-ahead  strategy  is  introduced  by  Guzzella  (2009)  and  the 
problem  is  solved  using  the  same  technique  i.e.  dynamic  program¬ 
ming.  Indeed,  the  problem  of  choosing  the  appropriate  gear  ratio 
to  meet  some  energetic  cost  is  a  mixed  integer  optimisation 
problem  for  which  real-time  solution  risks  to  be  hard.  In  future 
work,  the  authors  aim  to  introduce  energy  management  criteria 
following  a  predictive  approach  using  information  provided  by  the 
perception  level. 

5.2.  Conclusion 

In  this  paper,  a  longitudinal  control  design  based  on  nonlinear 
cascade  control  is  proposed.  The  cascade  loop  ensures  reference 
speed  tracking  and  torque  control.  The  longitudinal  controller  is 
coupled  with  a  lateral  controller  in  an  interconnected  architecture 
to  ensure  fully  automated  driving.  The  lateral  controller  is  based 
on  a  model  predictive  control  design.  Through  simulations,  the 
effectiveness  of  the  longitudinal  controller  in  tracking  time- 
varying  reference  speed  is  shown.  The  automated  guidance 
strategy  is  tested  using  real-world  trajectory  data  and  showed 
promising  results. 
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